#ifndef Motor_h
#define Motor_h

#include <WProgram.h>
#include <ServoTimer2.h>
#undef abs

class Motor
{
    public:
        Motor(); 
        void forward();
        void reverse();
        void rightReverse();
        void leftReverse();
        void rightForward();
        void leftForward();
        void turnLeft();
        void turnRight();
        void stop();
        void rightInit(int);
        void leftInit(int);
        void setSpeed(int, char);
        void turnLeft(int);
        void turnRight(int);
    private:
        int getPulse(int);
        ServoTimer2 leftMotor;
        ServoTimer2 rightMotor;
};

#endif